#include <Arduino.h>
#include <Scheduler.h>
#include "app_log.h"
#include "app_config.h"
#include "app_mqtt.h"
#include "app_stepper.h"

void setup()
{
    LOG_BAUDRATE(115200);
    LOG_INFO("\r\n");

//    auto *config_task = new ConfigTask(false, false);
//    SchedulerClass::start(config_task);
//
//    if (!config_task->configMode)
//    {
//        auto *network_task = new NetworkTask();
//
//        auto *serial_servo_task = new SerialServoTask(network_task);
//
//        SchedulerClass::start(serial_servo_task);
//        SchedulerClass::start(network_task);
//    }
//
//    SchedulerClass::begin();

    stepper1.setMaxSpeed(1000);
    stepper1.setAcceleration(300);
}

void loop()
{

    if (stepper1.currentPosition() == 0)
    {
        stepper1.moveTo(2048);
    } else if (stepper1.currentPosition() == 2048)
    {
        stepper1.moveTo(0);
    }

    stepper1.run();

//    if (Serial.available())
//    {
//        int data = Serial.parseInt();
//        Serial.print("Motor 'setSpeed' ");
//        Serial.println(data);
//
////        stepper1.moveTo(data);
//        stepper1.setSpeed(data);
//    }
}
